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This autonomous underwater robot control is a very challenging task because of autonomous underwater robot 
system nonlinearity, time-variance, uncertain external disturbance and difficulty in hydrodynamic modeling. 
Based on detailed autonomous underwater robot control survey and description of autonomous underwater 
robot dynamics, this paper proposes to introduce new control law algorithm based on high order sliding modes 
(HOSM) for depth control of the autonomous underwater robot. A comparison with classical sliding mode 
(SM) is carried out as well. These control techniques are based on second order sliding modes. High order 
methods allow overcoming the chattering effect by removing the discontinuity of the control vector. We show 
that these high order controllers hold the properties of classical SM control laws and remove chattering 
problem. Different simulations have been carried out to show the performance and effectiveness of the 
proposed method. 
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1. Introduction 


Autonomous underwater vehicles (AUVs) are unmanned robotic platforms that can be preprogrammed to achieve 
accurate navigation, control, and guidance tasks. Nowadays, AUV (Autonomous Underwater Vehicle) are widely used 
military, commercial and scientific purpose, (J.M. Spiewak,2007). These: 


e In the commercial field: The oil and gas industry uses AUVs to detailed maps of the seafloor before they start 
building subsea infrastructure; pipelines and subsea completions can be installed in the most cost effective 
manner with minimum disruption to the environment. 

e In the military field: A typical military mission for an AUV is to map an area to determine if there are any 
mines, or to monitor a protected area (such as a harbor) for new unidentified objects. AUVs are also employed 
in anti-submarine warfare, to aid in the detection of manned submarines. 

e In the scientific field: Scientists use AUVs to study lakes, the ocean, and the ocean floor. A variety of sensors 
can be affixed to AUVS to measure the concentration of various elements or compounds, the absorption or 
reflection of light, and the presence of microscopic life. 


The navigation and the control of AUV are difficult and complex topics. The dynamics of AUV are highly nonlinear 
and depend on several parameters that are difficult to measure precisely (as the hydrodynamic coefficients, the added 
mass terms...). Therefore, the control law must be robust against the parametric uncertainties and the environmental 
perturbations acting on the vehicle. 


The basic tasks in autonomous underwater systems are depth and steering control. A lot of control strategies have been 
adopted, all of them have advantages and disadvantages. It is possible to divide the algorithms in two groups: linear 
and nonlinear 
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In the linear methods: they are designed by using a vehicle’s linear model, identified in a specific behavior case 
(nominal forward speed, angle of attack, etc.). These methods are unable to control easily a vehicle, but they work in 
specific conditions and model nonlinearities are non-considered. Somme examples are PID control in (Jonghoon Park, 
2000) and Linear Quadratic Gaussian LQG in (W. Naeem, 2003). 


In the nonlinear methods: One of the most used methodologies in AUV control is the sliding mode control (SMC). For 
example the control of the NPS AUV by a typical SMC in (Marco, 2001) and an adaptive SMC in (Gianluca A, 2014), 
these strategies used linear vehicle’s model in the nominal control. One example of SMC using a simplified nonlinear 
vehicle model for the nominal control is the AUV Marius (Fryxell, 1996). The main drawback of SMC is the Chattering 
effect that can excite unmolded high frequency modes, which degrades the performance of the system and may even 
lead to instability. Chattering also leads to high wear of fins and increase electrical power consumption. Other approach 
use full nonlinear model (Silvestre, 2007), here a Lyapunov and back stepping techniques are used in order to control 
the AUV Infante. 


Sliding mode techniques are appropriate to underwater control, thanks to its robustness under parameters uncertainties. 
However chattering effect is its main disadvantage. In this paper, a recent method called HOSMC is implemented in 
AUV H160, in order to avoid the chattering problem and to improve control performance. High order techniques allow 
us to keep the main advantages of the classical SMC and to remove the chattering problem. The implementation of a 
second order sliding mode control in the AUV H160 using its simplified nonlinear model, is the main contribution of 
this paper. 


The paper is organized as follows. Section 2 presents the kinematic and vertical dynamic models of the AUV. A 
second order sliding mode control structure used for the AUV is described in Section 3. Effectiveness of the proposed 
schemes is demonstrated by simulation in Section 4. Finally, the conclusion is given in Section 5. 


1. Mathematical modeling 


The equations of motion for underwater vehicles can be presented with respect to a Body-fixed frame relative to an 
Earth-fixed frame, Figure 1. 


The position of the Body-fixed measured in the Earth-fixed is, 


x ? 
n 
n=[) RENE Beale a) 
1s 2 y 
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Figure 1, Reference marks representation 
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A. Kinematics model 


The vehicles-fixed linear and angular velocity and the time derivative of the earth-fixed vehicle position coordinates 
are related by the following relationships (Figure 2): 


n=J, (7, )o 
af (nm). [2] 2) 
I 03, Jo (72) vb, 
Where J.,(7,) is the transformation matrix of the linear velocity and J/,,(7,) is the transformation matrix of the 


angular velocity. This representation has a singularity for 6 = +90°. 


Ja lth = 
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Figure 2. Definition of swing angles 


B. Dynamic model 


The vehicle dynamics model derived by (SNAME, 1994) is based on a set of dynamic equations that govern the 
vehicle's translational and rotational motion in 3-D space. Using the Newton laws, the translational and rotational 
motions are: 


nea > F 
es ©) 


where F is the net external force applied to the vehicle, m is the mass of the vehicle, y is the acceleration of its mass 


center with respect to an inertial frame, M is the net external moment acting on the vehicle at the center of mass, I is 
the inertia tensor about the vehicle's mass center, and & is the vehicle's angular acceleration. 


The external forces and moments on the vehicle are due to gravitational, buoyancy, propulsive, control and 
hydrodynamic effects. As shown by (T.Salgado. Jimenez, 2003), the motion equations given by (5) can also be written 
in the form: 


M ppb + Cp, (v)v=T (6) 
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Where M,, is the inertia matrix including added mass, and C,,(v) is a matrix that includes centrifugal and Coriolis 


forces. 


v is the generalized velocity vector in the body-fixed frame, and vis the acceleration vector in the body-fixed frame. 
Generalized force vector I has the following components: 


P=lr,+r,4r,4T, (7) 


Where I, present the hydrodynamics force vector of the vehicle body, , is the static force vector (gravity and 


& 


buoyancy), I, is the controlled force vector (include the thruster force and the fin force) and I, _ is outside 


u 


disturbances force and moment acting on the AUV. 
i) Hydrodynamic forces 


In this section, we will discuss the hydrodynamic forces for AUV. The balance of efforts due to the inertia and mass 
of water added can be put in the form: 


—(M,b+C,(v)v) =, (8) 
Where M, is the added mass matrix and C,(v) is a Coriolis-like matrix 

The viscous damping force is given by the damping matrix D(v) is given by 

-D(v)v=T, (9) 
With T,=I,+I, is the vector of hydrodynamic efforts. 


ii) Hydrostatic forces 


A solid body submerged in a fluid will have upward buoyant force acting on it equivalent to the weight of displaced 
fluid, enabling it to float or at least to appear to become lighter. 


If the buoyancy exceeds the weight, then the object floats, if the weight exceeds the buoyancy, the object sinks. If the 
buoyancy equals the weight, the body has neutral buoyancy and may remain at its level. Discovery of the principle of 
buoyancy, which is a result of the hydrostatic pressure in the fluid, is attributed to Archimedes (figure 3). 


Hydrostatic force includes the gravity part WW and the buoyancy part BB. The balance of hydrostatic efforts can be 
put in the form: 


=s(7)=1; (10) 


- 
(a)B>W (b)B=w (c) B<W 


Figure 3. Hydrostatic equilibrium 


iii) Actuators of the robot 
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Actuators forces can be decomposed into lift and drag forces, perpendicular and parallel to the incoming fluid flow, 
respectively. 


The control plane forces in the body frame, acting at the center of pressure of the control planes, are computed as: 


When we use fins to control the motion of the AUV, the vehicle must maintain a surge speed. The propeller is used to 
generate energy to provide the surge force and then keep the vehicle moving ahead. Of course, the number of propellers 
mounted on the vehicle can be more than one. In the modeling process, we view the propeller as a special module and 
model it independently. 


The thrust force generated by a propeller and (A. Crosnier, 2001) can compute the rolling moment caused by the 
propeller: 


On the vertical control planes 
F. -0.5p5,V, (C,, sind, +C,, cos 6, ) 
F. |=| -0.5pSV2(C., sind, —C,, cosd 11 
Zz s' 0 zs Pp XS Pp 
M,| | F.(0.2c, cos6, —d,,)+F, (0.2c, sin 6, ) 
On the horizontal control planes 


-0.5pSV; (C,, sind, +C,, cos6, ) 
-0.5pS,V, (C,, sind, —C,, cos6, ) (12) 
F,(0.2c, cosd, —d,, )+ F, (0.2c, sin 6, ) 


a4 4 
I 


Where yp _is the fluid density, 5, is the surface of the wing S,=b,xc, , VY, 1s the modulus of the fluid flow around 
the wing, 0.2c, is the distance from the leading edge of the wing at its point of application of hydrodynamic forces, 
C,, and C,, represent the coefficients of lift and drag. 


ys 


When we use fins to control the motion of the AUV, the vehicle must maintain a surge speed. The propeller is used to 
generate energy to provide the surge force and then keep the vehicle moving ahead. Of course, the number of propellers 
mounted on the vehicle can be more than one. In the modeling process, we view the propeller as a special module and 
model it independently. 


The thrust force generated by a propeller and (A. Crosnier, 2001) can compute the rolling moment caused by the 
propeller: 


T, = pD;K,(J,)|n,|", (13) 


Q=pD,K, (J,)|, 


a (14) 


Where n, is rotating rate of the propeller, p is the fluid density, D, is the propeller diameter, K, is the thrust 
coefficient, K, is torque coefficient J, =V, I(n »D, ) is the advance number. V,_ is the advance speed at the propeller 


(speed of the water going into the propeller) which has a relationship with surge velocity V, : V, =(1-w,)V, 


Where w, is the wake fraction number (typically: [0.1:0.4]). 


The final dynamic equation of the robot is as follows (Bekit. B, 1997): 


Mvb+C(v)v+D(v)v+g(n)=0 (15) 


Where 
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M =M,,+M, is the inertia and added mass matrix, C(v)=C,,(v)+C,(v) 1s the matrix of Coriolis and centripetal 
forces, from inertia and hydrodynamics, D(v) is the hydrodynamic damping and g(7)_ is the vector of restoring 


forces and moments. [. is control-input vector describing forces and moment efforts 


Tr =[6,,6,.7] (16) 


pec 


With 6, is the fin angle of AUV,6, _ is the rudder angle of AUV, n_ is the revolution of propeller as thrusters of 
AUV. 


B. General equation of motion 


The nonlinear vehicle equation of motion is written as: 


n=J.(7,)v (17) 
Mb+C(v)v+D(v)v+g¢(9) =P 
Hence, the global state vector is represented by: 
(7,v)=[x y z¢Owuvyw pq r] (18) 


C. Depth plane model 


In this article, we are interested to study the behavior of autonomous underwater robot in the depth plane, so we only 
need to position (z) , the pitch angle (@) , linear velocity (w) and angular velocity (gq). 


Then we considered the other variables states as null. 


Ww —0.7234 0.2374 0 0 || w —0.2858 

j 0.6398  —2.1281 -0.2478 0 —1.8904 

7 |e ae 6 (19) 
0 0 1 0 0|| A 0 p 

Zz Oj] z 


1 0 —1.8 0 


2. Sliding mode controller 


Nonlinear model based control systems offer a level of dynamic capabilities which linear techniques are incapable of 
providing when dealing with parameter uncertainties and unmodelled dynamics. Sliding mode (Edwards, 1998), is 
categorized as a variable structure control system which has excellent stability, robustness, and disturbance rejection 
characteristics. This type of control is not new to submarines, in fact it is widely used due to its capability to overcome 
modeling errors (due in this case to the hydrodynamic terms and modeling as an uncoupled system). Sliding mode has 
been used in spacecraft (Lo.S, 1995), robotics (Bekit. B, 1997), missiles (Edwards, 1998), and many other applications 
where modelling error is a concern. 


The idea behind SMC is to define a surface along which the process can slide to its desired final value (Gamal A 
Elnasbar, 2014), (Mohammed Reza, 2015). The structure of the controller is intentionally altered as its state crosses 
the surface in accordance with a prescribed control law. The SMC control law consists of two additive parts. That is: 


u= Ueg + U giis (20) 


Where 


u., «Nominal control, which is determined by the robot model. 


U,;., «sliding part, which is useful to compensate model uncertainties. 


glis 
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Sliding surface in the state error space for tracking problem is defined and now the state errors are: 


Sr 
i 
= 


Sse (21) 


Nr Dr-Qr 
S 
> 


Where x, desired tracking state. Now, sliding surface can be defined in the error state space form as follows 


Sr 


= Sk (22) 


DBe'Qr 


s=[a By wl 


Nr 


Wherea,f,y and w are the sliding surface constants. The sliding surface s must obey the next condition: 
Sis chosen so that lims +0 and lims — 0 _, assure the convergence of the error state space lim x > 0. The Lyapunov 


: : 1 
candidate function V(s)= ae , represents the decay of the energy’s system, and guaranteed that the system state 


converge to the sliding surface if the following sliding condition is respected (Xueli wu, 2014): 


V(s)=si <—n|s| (23) 
Or, 
5 <-1’sign(s) (24) 


Differentiating the sliding surface (22), we obtain: 
§ = S"X = 8" (Ax+ Bu-%,)<-n’sign(s) (25) 


The sliding surface time derivative permits to express the two parts of the control: u, , and u,,. , with 


eq ? glis ? 


u=-(S™B) ST Ax-(S"B) | S"%,-(S"B) 1sign(s) (26) 
Then, the control to apply to the system is deduced: 


us U og + U giis 
u,, =-(S™B) |S" Ax—(S"B) ST%, (27) 
U stig = — (s™B) 77 sign(s) 


In our case, the desired states are constant values, so x, =0 . thus (27) becomes: 


us Ue, BE YU otis 


Ugg =—(S"B) |S" Ax =—kx (28) 
tie = —(S™B) 7 sign(s) 


The nominal control u,, is calculated for s = 0, that is to say when the system is on the sliding surface. So, the feedback 
gain vector k is calculated to place the eigenvalues of the closed loop system in [Z, 4, --- 4, 0], to have the 


n 


desired dynamic in the sliding surface. 
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Thus, the robot linear model (19) becomes: 


«= Ax + Bu,, =(A-Bk)x = 4.x (29) 
With 4, , the closed loop state matrix. 


The sliding surface coefficients S are calculated to have s =0, so (25) becomes: 


g=Ss=S's=S8' Ax=0 (30) 
A solution of (30) is: 
§'A,= 4S =[0] (31) 


Therefore, S' is the eigenvector of A’ associate to the null eigenvalue 
Finally, the sliding surface and the command are given by the expression: 


u =—(—0.3525w +0.6095q — 0.00376) —0.25sign(w—4.9066q —5.19980 +0.6941(z—z,)) (32) 


In the standard SMC, is discontinuous; this is the main reason why high frequency switching appears in the output 
signal (chattering effect), which causes problems in practical application. In order to avoid chattering, a high order 
sliding control is used (V.Creuze, 2002; J.M.Spiewak, 2007). HOSMC acts on the higher order time derivative of the 
system deviation, instead of influencing the first deviation derivative as it happens in SMC (A.Crosnier, 2001). Its 
principal characteristic is that it keeps the main advantages of the SMC, removing the chattering effects. The sliding 
order is a number of continuous total derivatives of approximately the sliding mode (Figure 4) 


The proposed second order sliding mode control can be used as an alternative natural approach for smoothing the input 
signal. The sliding order is a measure of the degree of smoothness of the sliding variable approximately the sliding 
mode. This proposed technique can be considered an extension of the first order-sliding regime. It is composed of two 
parts (Manjusha bhave, 2015), (Sandeep kaur, 2014): 

= [tay + Ku | (33) 


glis glis 


State Space 
X (to) 


State trajectory 


Figure 4. Second order sliding mode trajectory 


fu ais 18 composed of the integral of the function sign multiplied by a constant K,,, . 


fe, is designed by using the equivalent command method for the new sliding surface s . 


It is necessary to express the previous system (23) to appear the derivative of the control output 
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w] [0 0 0 0 1 0 0l[w 0 
qg| |0 0 0 0 0 1 Ollg 0 

6| |0 1 0 0 0 0 0|| 6 0 

z{|=/0 0 0 0 0 0 1}j}zj+} 0 6, (34) 
wl 10 0 0 0 -0.7234 0.2374 O|]/w| | 0.2858 

g| |0 -0.2478 0 0 0.6398 -2.1281 0|| 4] | 1.8904 

|Z] [0 -18 0 0 1 0 oll Z| 0 


The new sliding surface is defined as follows: 


Ss, =St+As 

oe 7 (35) 
=aw+t Bq+adw+(y+ BA)q+yAO+ pz 
The equivalent command for the second order sliding technique is defined as follows: 
Ug = 0.2412w— 0.06374 + 0.58220 + 0.69412 (36) 
Finally, the command output is written: 
6, = 0.2412w- 0.06374 + 0.58226 + 0.69412 

(37) 


~0.25sign (w—4.9066q + 0.69412 + w—10.1064* q 5.19980 +0.6941(z—z,)) 


3. Simulation results 


In this section, numerical simulations in the AUV hydrodynamic simulator are presented. It is a small size and low 
cost torpedo-shape AUV, used in very shallow water applications. Itsdimensions are 1.9 m of length, a diameter of 
0.25 m and a weight of 40 kg(for more details see (J.M.Spiewak, 2007)). 
In the simulation, the following initial conditions areconsidered: 

e The desired outputs are position steps; z, =10.0m and@, =0.0° 

e We consider that the vehicle is on the surface z, = 0.0 mand the pitch angle is 0, = 0.0° 

e The AUV surge is constant: u =u, =1.5 m/s 


In numerical simulations, we add noise on each hydro-dynamic coefficient to simulate model’s uncertainties. 
Moreover, we use a sea current to simulate environmental disturbances. 


The robot reaches its desired depth z, in 15s approximately (figure 5) with a zero pitch angle 6 = 0° (figure 6). Indeed, 
as long as the desired depth z, is not reached, the control surfaces are saturated (figure 7). 


5 - 60 
—sign —sign 
0 sl 40 —tanh 
= = =) 
= 45 S 20 
N SJ 
10 0 
-15 -20 
5 10 15 20 25 30 0 5 10 15 20 25 30 
Time (s) time (s) 
Figure 5. Depth control of robot with SMC Figure 6. Pitch angle of robot with SMC 


We can note in Figures (8-10), that the desired values are reached in spite of the sea current, of the parameters 
uncertainties and of the simplified linear model. The robustness of the SMC is due to the hard request of the rudders. 
The continual motion of the rudders is called, the chattering effect, and is due to the s discontinuities. The chattering 
effect could excite the torpedo’s own modes and damage the system. Moreover, the chattering effect causes an over 
consumption of energy. 
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40 T 
—sign —sign 
20 [tanh 0 ant 
3 > ‘ 
BS 0 E 5 
oS N 
-20 10 
-40 ; ‘ -15 
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Figure 7. Rudder control of the depth with SMC_ Figure 8. Depth control of robot with SMC in disturbed 


60 
—sign 

40 ——tanh 
3 3 
8 a g 
S a) 

0 
-20 
0 10 20 30 40 50 60 70 80 0 10 20 30 40 50 60 70 80 
Time (s) Time (s) 
Figure 9. Pitch angle ofrobot with SMC in disturbed Figure 10. Rudder control of the depth with SMC 
environment. in disturbed environment 


A solution to limit this drawback is to replace sign(s) by tanh (<) . The ¢ parameter allows setting the boundary 


layer thickness. Figure 7 shows the results for the sign function and for the hyperbolic tangent function. However, this 
solution is not optimal owing to the fact that the system loses local robustness and that chattering reappears when the 
noise of the sensors is added with simulations (figure 10). Another solution toavoid the chattering effect is to use a 


high order sliding mode control. 


The robot reaches its desired depth z, in 17s approximately (figure 11), with the high order sliding mode control 


method. 
We can see in Figure (12-16), the numerical simulation’s results. With this control law, the amplitude of the chattering 


effect is reduced. In practice (figure 13, figurel6), s can be unobservable, so its sign can be estimated by the sign of 
the first difference of the available sliding variable s ina time interval Ar . 


5 60 
—smc —smc 
r ia “ —HOsMc 
> F) 
E45 3S 20 
~ ) 
-10 0 
-15 -20 ; 
0 5 10 15 20 25 30 0 5 10 15 20 25 30 
Time (s) Time (s) 
Figure 11. Depth control of robot with HOSMC Figure 12. Pitch angle of robot with HOSMC 
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Figure 13 . Rudder control of the depth with HOSMC Figure 14. Depth control of robot with HOSMC in 
disturbed environment 


—SMC 
—HOSMC | 


10 20 30 40 50 60 #70 + 80 0 10 20 30 40 «50 + 60 70 80 

Time (s) Time (s) 
Figure 15. Pitch angle of robot with HOSMC in _ Figure 16. Rudder control of the depth with HOSMC 
disturbed environment in disturbed environment 


4. Conclusion 


In this paper, we describe the robust control design laws methodologies, based on a simplified linear model of the 
autonomous underwater vehicle. Both simple and the high order sliding mode control are proposed and using in 
numerical simulations to control depth of autonomous underwater. 


We can note that the SMC with the sign function consumes a lot. The use of hyperbolic tangent function instead of the 
signe in the simple sliding mode control reduces considerably the chattering effect. With the added sensors noise, 
which is closer to a real application condition, we noticed the reappearance of the chattering effect in the sliding mode 
control signal using hyperbolic tangent function. So the chattering effect is not reducedand we have to find a solution 
to overtake this limitation. 


The implementation of the high order sliding mode control of the autonomous underwater vehicle is the solution we 
suggest and the most interesting contribution of this paper. Taking into account of the derivative of the sliding surface 
in the calculated command, the system reaches the sliding surface more slowly, we thereby avoiding the chattering 
effect, although we added the sensor noises simulation. 


Finally, the sea current and parameter uncertainty are rejected by the first and second order sliding mode control laws. 
We can conclude that HOSM controllers eliminates the chattering effect and improve the system's accuracy 
convergence towards its desired behavior despite the presence of disturbances in comparison with the SMC controllers. 
The HOSMC controllers give better performance. 


As a future work: The real time experimentation. 
The implementation of the high order techniques to the roll plane. 
The implementation of the sliding-mode control third order to the vertical and horizontal plane. 


The implementation of the fuzzy high order-sliding mode control ZHOSMC to the horizontal and vertical plane. 
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